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Abstract — We consider the problem of sensor localization in 
a wireless network in a multipath environment, where time and 
angle of arrival information are available at each sensor. We 
propose a distributed algorithm based on belief propagation, 
which allows sensors to cooperatively self-localize with respect 
to one single anchor in a multihop network. The algorithm has 
low overhead and is scalable. Simulations show that although the 
network is loopy, the proposed algorithm converges, and achieves 
good localization accuracy. 

Index Terms — Distributed localization. Wireless Sensor Net- 
work, belief propagation, non-line-of-sight. 

I. Introduction 

A wireless sensor network (WSN) consists of many de- 
vices (or nodes) capable of onboard sensing, computing and 
communications. WSNs are used in industrial and commercial 
applications, such as environmental monitoring and pollution 
detection, control of industrial machines and home appliances, 
event detection, and object tracking |[T]-|[3]. In most appli- 
cations, the data collected by the sensor nodes can only be 
meaningfully interpreted if it is correlated with the location 
of the corresponding sensors. The Global Positioning System 
(GPS) is widely used for localization in outdoor environments 
Q. However, GPS is a costly option and is not suitable for 
power-limited sensor nodes in WSNs. Furthermore, GPS sig- 
nals do not penetrate well to indoor environments. Therefore, 
alternatives to GPS localization have been widely studied [4|, 
|[5j. In a WSN, nodes whose positions are known are called 
"anchors". By making use of pairwise range or angle mea- 
surements between anchors and/or other sensor nodes whose 
positions are unknown, sensors with no access to GPS can 
perform self-localization. Typical techniques include the use 
of time-of-arrival (TOA), time-difference-of-arrival (TDOA), 
received-signal-strength (RSS) and/or angle-of-arrival (AOA) 
information in triangulating the location of a node. This is 
usually studied in line-of-sight (LOS) environments fSl, (7]. 

However, LOS signals do not always exist in urban or 
cluttered environments, where signals usually experience mul- 
tiple refections and diffractions. Such signals are referred 
to as nonline-of-sight (NLOS) signals and are commonly 
encountered in both indoor (e.g., residential buildings, offices 
and shopping malls) and outdoor (e.g., metropolitan and urban) 
environments. NLOS errors mitigation techniques have been 
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extensively investigated |[8)-p4), but most of the algorithms 
in the literature focus on locating one single sensor with 
several anchors. Since they require each sensor to have direct 
signal paths to anchors in the network, such algorithms cannot 
be applied in network-wide localization. On the other hand, 
several algorithms for network-wide localization have been 
proposed in the literature Q, p3)-p8). Unfortunately, only 
LOS signals are considered in these algorithms. 

Distributed localization algorithms for multipath environ- 
ments were proposed in p9) , pO) , where NLOS error is 
modeled as a positive bias in range and angle measurements, 
and its statistical characteristics are inferred by numerical 
methods, such as bootstrap sampUng in p9) , and particle filters 
in I pO) . One of the major disadvantages is that these Bayesian 
inference techniques require a large number of observations 
and are computationally expensive. Generally, the statistical 
model for NLOS errors depends on various factors, such as 
signal bandwidth, propagation medium and environment tem- 
perature. Different models including the uniform, exponential 
and Rayleigh distributions, have been proposed in the literature 
|2il, 122|. 

Instead of modeling NLOS errors in multipath environments 
as random biases, geometric analysis can be applied in pair- 
wise localization |12J-[14J, where measurements of different 
paths are modeled using closed-form expressions, which sig- 
nificantly simplifies the system model. In this paper, we derive 
a distributed localization algorithm based on range and direc- 
tion measurements at each node, and where nodes exchange 
information to cooperatively perform self-localization relative 
to a fixed reference node. We show through simulation that by 
exchanging limited information, all the nodes in the network 
can perform localization to a good accuracy. We compare 
the performance to that achieved without cooperation, and 
show that cooperation amongst neighboring nodes significantly 
improves the localization accuracy. 

The rest of this paper is organized as follows. In Section 
[n] we define the system model. We describe our algorithm in 
Section llllj and provide simulation results in Section IV In 
Section |V] we summarize and conclude. 

II. System model 

Consider a network of M + 1 sensors, {Sq, Si, - ■ ■ , Sm}- 
The position of Si is s,; = {xi, yi), where Xi and j/,; are its x- 
and y-coordinates respectively. Without loss of generality, we 
assume that the position of Sq is known and that Sq = (0,0). 
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Fig. 1. An example for single-bounce scattering path between Si and Sj. 



The objective of each Si is to perform self-localization relative 
to 5o. 

In the following, we consider two nodes Si and Sj. Similar 
to p4) , we describe a model to relate the range and direction 
measurements at each node to their positions. Suppose that 
there are R LOS or NLOS paths between Si and Sj. An 
example of a single-bounce scattering path is shown in Figure 
[T] where the signal from Sj to 5*^ is reflected at a nearby 
scatter, and the communication link between two nodes is 
assumed to be symmetric. Let be the distance measured 
by Si using the time-of-arrival information of the signal along 
the r* path from Sj, and be the corresponding angle-of- 
arrival information. Nodes 5,; and Sj exchange measurements 
with each other, so that both nodes have the measurements 

/W^ rl^ fi^ f)^ \^ 
I U' ji' i J ' jilr=l- 

Consider the r* path between Si and Sj . Given the position 
of Sj and {dlj,d^i,9lj,9ji}, the position of Si cannot be 
determined with certainty even in the absence of measurement 
and communication noise. As shown in Figure [T] the estimated 
position for Si can be any point along the line AB. If there are 
multiple paths between Si and Sj from non-parallel scatters, 
the position of Si can be found as the intersection point of 
two such lines. Suppose that there is no measurement noise, 
then a straightforward geometric consideration shows that 
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where and pb are the positions of A and B respectively. 
A vector perpendicular to pA Pb, is 
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Since both A and Si are on the line AB, we have n^J^Sj 
n^gPA, from which we obtain 
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which can be further simplified as 
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where 
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We have made use of the fact that — d^i for symmetric 
communication links between Si and Sj in ([3]). We have 
not factored in measurement and communication noise up 
to this point. Let the corresponding noisy measurements be 
{dji,9ji, dij}. Modeling the total effect of noise as a Gaussian 



random error w^^, we have 



(4) 



We assume that measurements for the R paths are such 
that |g (j)ji, 0ij^ : r — 1, . . . , i?| are linearly independently, 
otherwise some of the paths are duplicates of each other We 
also assume that the noise terms m^r, are i.i.d. Gaussian random 



variables with zero mean and variance cr^. Stacking the mea 
surements from all R paths into a vector dji — [dj^, 

and letting Gji = 



nj^] , we can estimate the position of Si 
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from Sj using 
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where G^^ is the Moore-Penrose pseudo-inverse of the matrix 



Gji. If there are more than one signal paths between nodes Si 



and Sj, we have Gj^ — 



{GjiG.iY 



Gjj. If there is only one 



signal path, G], = Gj, (G.^Gj^) \ Let S,, = G],(G],, 
The posterior distribution of the node locations is given by 
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Similar analysis in [14| proposes a least square estimator 
to localize a single node with respect to a reference node. 
However, to localize every node in a network, it is necessary 
to consider the interaction between 5, and all the other nodes 
{^j}jLo j^i- The MAP estimator for is given by (jTji on top 
of next page. The joint posterior distribution in (j7]i depends 
on interactions amongst all the variables and is difficult to 
compute by brute-force integration. 

In order to provide a computationally efficient algorithm 
to calculate the marginal distributions, we observe that the 
state at any sensor depends directly only on its neighboring 
sensors whose number is usually far less than the total num- 
ber of variables. To explore such conditional independence 
structure, we make use of belief propagation in the following 
and propose an efficient algorithm which computes a set 
of marginal distributions from the joint posterior distribution 
without performing a full integration as in (j7]i. 

Remark 1: When there exists a LOS path between Si and 
Sj, it is easy to see that l^j^ — 
which is a special case of (pll. 

Remark 2: When there exists paths with multiple bounces 
between Si and Sj, a two-step proximity detection scheme 
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Fig. 2. An example for the factor graph of a network with 5 nodes, where 
dashed lines indicate that a one-bounce scattering path exists between the 
corresponding two nodes, and the aiTows indicate the direction of message 
flows. 

suggested in fl4] can be applied to detect and discard such 
paths, leaving measurements from either LOS and/or single- 
bounce paths for processing. 

III. Distributed localization based on belief 

PROPAGATION 

We use Belief Propagation (BP) on a factor graph f23l in 
this paper. An example for a network with 5 nodes is shown in 
Figure |2] Each random variable Sj is represented by a variable 
node (circle). The interaction between two sensors 5*^ and Sj 
is represented by a factor node (square) connected to both 
variable nodes and Sj. We split the interaction between Si 
and Sj into two factors fji = p{si — Sj \ Gj^dji, Gji), and 
fij = p{sj — Si I Gljdij,Gij). Since messages only flow in 
one direction along the edges in the factor graph, they can be 
broadcast by the sensor nodes. 

Without loss of generality, suppose the sensor 5*0 is the 
anchor with a known position (0, 0). For each variable s^, i E 
{1, • • • , M}, the marginal posterior distribution m{si) is found 
by iterative belief propagation, where two kinds of messages 
are involved, 

• 6|''(si): belief of its own state at the variable node s.^ 
after the /"^ iteration, 

where Bi is the index set of Si's neighboring sensors. 

• /iy.''._j.s. (si): message from the factor node fji to the 
variable node in the Z'^ iteration, which represents fji's 
belief of s^'s state, resulting from interactions between 



and Sj, 

4?.^s.(s0 = / P(s. -s, I Gtd,,,G,,)6^'^(s,) ds,. (9) 

Therefore, setting the initial belief h'>'^\si) to be the corre- 
sponding prior distribution p{si), beliefs (jsjl and messages 
(|9]l are iteratively updated at each sensor, and the estimation 
for Si is found by maximizing the converged belief bf\si) 
with respect to s^. When prior distributions {p{si)}fLi are 
Gaussian, closed-form expressions for beliefs and messages 
can be obtained as follows. 

A. Derivation for closed-form beliefs and messages 

To derive closed-form expressions for ([8]l and (j9]), we first 
consider the message from the anchor 5*0 to a neighboring 
sensor Si. Since Sq = (0, 0), its belief is a constant and can 
be represented as 6q^(so) = 5{sq, (0,0)}, where 5{-,-} is the 
Krocnecker delta function. Therefore, the message from S'o to 
Si will be constant over all iterations, and is given by 

41Us, (sO = j P{^^ - So I Gj^do,, Goi)5{so, (0, 0)} dso 
(x7V(s, ; iyo»,WoO- (10) 
where Uq^ = G^^d^i and Wq., = cr^Soi with Sq; = 

Other the other hand, for all nodes Sj other than S'o, we 
set the initial belief of Sj as a Gaussian distribution with zero 
mean and large variance, i.e., for j = 1, • • • , M, b^^\sj) — 
Af(sj ; nf\pf^y where /xf' = (0,0), and we define 

p(o)^r ah if\Bj\>l, 
I Otherwise, 

where a is a large positive value of at least an order of 
magnitude larger than the dimension of the environment in 
which the sensor nodes are located. Let \Yj^^ largest 
eigenvalue of S^j. We assume that a > 2a maxij A™^'^. 

As the BP algorithm proceeds, the belief b':^~^\sj) for 
Sj after I — 1 iterations is updated as ^\sj) = 
M (^Sj ; P^'^^^^ and its message to Si in the /"^ 

iteration is 

h^l^^isi) = J Pis, - s, I Gtd,„G,,)&?"'^(s,) ds, 
where 

i^:-^)=Mr^^+Gtd,„ (11) 

Wf-^^ ^a^-Ej,+p'j-^\ (12) 



Algorithm 1 Distributed Localization in Multi-path Environ- 
ments 



Initialization: 

Set the position at the anchor Sq as Sq ~ (0,0). 



Set (1 



(0) 



(0,0) and 
d(o) _ 



ah if|S,|>l, 
3^l2 Otherwise, 



Iteration until convergence: 
for the iteration do 

sensors 5*, with i = 1 : M in parallel 

broadcast the current belief bf ^'(si) to neighboring 
sensors; 

8: receive b'j from neighboring sensors Sj, where 

J e Bf, 

9: update its behef as bf^ (s;) - , Pf ^) with 



,(0 



w 



and 



(0 



(/-I) 



,('-!) 



where i/^ and are given in 

respectively. 

estimate its position as ' — ^fK 
end parallel 
end for 



^ and 



The message h^P_^^{si) is a Gaussian distribution, so only the 

mean i/j^ and covariance matrix W^'^' need to be passed to 
node Si. 

The belief of after the l^^ iteration then follows from 
(|8|. Since all the messages in the product in dSll are Gaussian 



distributions, we have 6-''(si) = M (si ; /x- ,P,f''' ) with 



P 



W 



and 



(0 



W 
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(13) 



(14) 



At the end of the /'^ iteration, sensor 5; estimates its position 
by maximizing the belief b[''\si) with respect to s^. Since 
b[''\si) is a Gaussian distribution, the estimator for at the 
Z*^ iteration is given by sf^ = . This iterative procedure 
is formally given in Algorithm [T| Notice that factor nodes are 
virtual, and are introduced only to facilitate the derivation of 
the algorithm. In practice, the update is performed at each 
individual sensor directly. 

IV. Simulation Results 

Numerical simulations are conducted to validate the effec- 
tiveness of our proposed algorithm. We consider a network 
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(a) absolute errors on x-coordinates. 
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(b) absolute errors on y-coordinates. 

Fig. 3. Cumulative distribution function of absolute localization errors where 
scatters are orthogonal. 



with 5 nodes randomly distributed in a 10m x 10m square area. 
The factor graph is that in Figure [2] where Sq represents the 
anchor with a fixed location at (0, 0), while the other nodes are 
the remaining sensors' locations. We set Si = (—4.5,-1.5), 
S2 = (4.0,-1.0), S3 = (-1.0,-8.0), and S4 = (4.2,-6.0). 
Any two nodes that can communicate with each other through 
single-bounce scattering paths are connected with their con- 
nection indicated by a dashed line. The ranging measurement 
errors are i.i.d. Gaussian random variables with zero mean 
and standard variance 3. The measurement error for AOA is 
assumed to be uniformly distributed in [—5°, 5°]. Each point in 
the figures is an average of 10^ independent simulation runs. 

First, we consider scenarios where scatters are orthogonal. 
We compare the performance of cooperative and pairwise 
localization. The cumulative distribution functions for absolute 
localization error of each sensor are shown in Figure [3] 
Corresponding to the factor graph in Figure |2] sensors Si 
and 5*2 are directly connected to the anchor Sensors 5*3 and 
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TABLE I 

Mean error of estimated location at each sensor 



Localization scheme 


Mean EiTor 


Si 


5-2 


5-3 


54 


Cooperative 
Localization 


\Xi 1 


1.0048 m 


0.9558 m 


0.9459 m 


0.9834 m 


IVi - Vil 


0.4914 m 


0.4385 m 


0.7639 m 


0.9590 m 


Pairwise 
Localization 


\xi X'^ 1 


1.5119 m 


1.5034 m 


1.6823 m 


1.5529 m 


IVi - Vil 


0.5145 m 


0.4544 m 


1.1562 m 


2.2827 m 



^4 do not have any paths to the anchor. Instead each has a 
NLOS path to Si or 52 respectively, and a NLOS path between 
themselves. In pairwise localization, ^3 localizes using only 
measurements from 5*1, and S4 localizes with respect to S-z- 
It can be seen from Figure |3(a)| that 6*3 and ^4 are localized 
with larger errors than 5*1 and 5*2, and this is because errors 
are accumulated over hops. In cooperative localization, ^3 and 
54 exchange information and incorporate measurements from 



the NLOS path between themselves. As shown in Figure 3(a) 
the cooperative localization achieves better performances with 
more than 90% of the localization errors less than 2m and all 
errors smaller than 3m. Moreover, results for estimation on 



y-coordinates are shown in Figure 3(b) It can be seen that 
both schemes have similar performances for sensors directly 
connected to the anchor (e.g.. Si and S2), and cooperation 
localization for ^3 and 5*4 achieves better performances. The 
mean absolute errors for both schemes are further shown in 
Table |l] 

Second, we consider scenarios where scatters are horizontal 
or at angle 45° to the horizontal. As can be seen from 
Figure |4] cooperation among neighboring sensors improves 
performance on both x- and y- coordinates. We also note that 



compared with Figure 3(b) estimation errors for ^-coordinates 
deteriorate due to correlation between measurements on the 
vertical direction. On the other hand, we investigate the con- 
vergence rate for our proposed algorithm in this biorthogonal 
scenarios, and the result is shown in Figure [5] Simulations 
are also conducted when scatters are at 10°, 20° and 30° to 
the horizontal. Similar results as in Figure [5] are obtained and 
hence omitted here. These numerical results suggest that even 
for scenarios with non-orthogonal scatters, the mean of belief 
at each sensor converges in the proposed algorithm. 



V. Conclusions 

In this paper, we propose a distributed algorithm based on 
belief propagation for network-wide localization in multipath 
environments. The proposed algorithm requires communica- 
tions only between neighboring sensors, with each sensor 
processing only information local to itself. The proposed al- 
gorithm has low overhead and can achieve robust and scalable 
localization. By utilizing both TOA and AOA information of 
the single-bounce scattering paths, we require only one anchor 
in the whole network, and sensors that do not have LOS/NLOS 
paths to the anchor can be localized by cooperation with its 
neighboring sensors. Simulation results show that our pro- 
posed algorithm achieve accuracy less than Im in a 10m x 10m 
square area. 
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(b) absolute errors on y-coordinates. 

Fig. 4. Cumulative distribution function of absolute localization errors when 
scatters are horizontal or at 45°. 
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